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(54) Apparatus for calculating and correcting deflection of central axis of an obstacle detecting 
apparatus mounted on a vehicle, and system for controlling distance to a preceding vehicle 
travelling ahead 

(57) The present invention aims to facilitate easy 
correction of the center axis of an obstacle detecting 
apparatus for a vehicle by calculating deflection of the 
center axis with respect to the vehicle. Each of most 
obstacles recognized as moving objects is a preceding 
vehicle 93, and when the subject vehicle 91 is moving FIG 3 

straight, the preceding vehicle 93 is detected in a posi- 
tion straight ahead of the subject vehicle 91 . If the opti- 
cal axis 95 of the transmitting/receiving section 31 is 
oriented straight ahead of the subject vehicle 91 , the 
preceding vehicle 93 will be detected on the optical axis 
95. On the other hand, when the optical axis 95 deviates 
from the center axis of the vehicle, the preceding vehicle 
93 is detected in a position deviated from the optical 
axis 95 by an angle Om. In this case, the value 9 of 
deflection of optical axis 95 is equal to -Om. In addition, 
by determining whether or not the relative velocity vec- 
tor component of an obstacle is within a given range, the 
accuracy of calculation can be bettered with data of 
vehicles moving in an adjacent lane and data of vehicles 
moving along a curve being removed. 
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Description 

BACKGROUND OF THE INVENTION 
5 [Field of the Invention] 

The present invention relates to an apparatus for calculating how much a central axis of an obstacle detecting 
apparatus for a vehicle deflects from the centerline of the vehicle along a longitudinal direction, In which the obstacle 
detecting apparatus is mounted on the vehicle and serves to radiate a transmission wave over a given angular range 

10 from a given central axis to the width direction of the vehicle for detecting a distance to and an angle of an obstacle in 
response to a reflected wave from the obstacle. The invention also relates to a deflection of central axis correcting appa- 
ratus for correcting the deflection of central axis of the obstacle detecting apparatus. Further, the invention relates to an 
inter-vehicle distance control system for controlling a distance between a system vehicle equipped with the system and 
a vehicle ahead of the system vehicle on the basis of the central axis of the ot>stacle detecting apparatus the deflection 

75 of which has been corrected . 

[Description of the Related Art] 

An obstacle detecting apparatus is designed to be mounted on a vehicle and to serve to radiate a transmission 
20 wave, such as an optical wave or an electromagnetic wave, over a fonward detection zone defined by a given angle to 
the width direction of the vehicle for detecting a distance to and an angle of an obstacle such as a preceding vehicle on 
the basis of a reflected wave from the obstacle. This type of obstacle detecting apparatus is used in an inter-vehicle dis- 
tance control system for detecting a preceding vehicle ahead of a system vehicle equipped with the system and holding 
a distance between the vehicles at a constant value, or in a warning control system for issuing an alarm when the sys- 
25 tern vehicle moves into proximity to an obstacle. 

Such an obstacle detecting apparatus must be mounted on a vehicle such that the central axis of the apparatus is 
exactly in line with the centerline of the vehicle along the longitudinal direction. If both deviates from each other, an error 
in detecting an angle of the obstacle appears. In this case, the obstacle detecting apparatus may recognize a vehicle 
traveling along an adjacent lane as the preceding vehicle, or it may recognize the preceding vehicle as an object other 
30 than the preceding vehicle. 

However, a highly accurate adjustment Is required to put the central axis of the obstacle detecting apparatus exactly 
in line with the centerline of the vehicle along the longitudinal direction, and therefore a problem arises that this instal- 
lation takes time. 

35 SUMMARY OF THE INVENTION 

It is an object of the present invention to provide an improved apparatus for calculating a deflection of central axis 
of an obstacle detecting apparatus relative to a vehicle equipped with the system to facilitate correction of central axis 
of the obstacle detecting apparatus. 

40 In order to achieve the above object, a first aspect of the present invention provides a deflection of central axis cal- 
culating apparatus which is used for an obstacle detecting apparatus mounted on a vehicle, the obstacle detecting 
apparatus serving to radiate a transmission wave over a given angular range along a central axis thereof for detecting 
a distance to and an angle of an obstacle, and which comprises, as shown in Fig. 15A, object recognizing means for 
determining whether the obstacle is a stationary object or a moving object on the basis of the distance to and angle of 

45 the obstacle detected by the obstacle detecting apparatus; speed calculating means for calculating a vector represent- 
ing a speed of the obstacle relative to the vehicle; and first deflection calculating means, when a target obstacle is 
selected from among obstacles detected by the obstacle detecting apparatus under conditions that the target obstacle 
has been recognized as a moving object by the object recognizing means and the relative speed thereof calculated by 
the speed calculating means falls within a given range, which calculates the deflection of central axis of the obstacle 

so detecting apparatus relative to the vehicle on the basis of the angle of the target obstacle. 

In the deflection of central axis calculating apparatus according to the first aspect of the present invention, the 
speed calculating means calculates a speed vector of the obstacle relative to the vehicle on the basis of changes in the 
distance to and angle of the obstacle detected by the obstacle detecting apparatus. The first deflection calculating 
means calculates a deflection of central axis of the obstacle detecting apparatus relative to the vehicle on the basis of 

55 the angle of the target obstacle detected by the obstacle detecting apparatus. As previously described, the target obsta- 
cle is selected from among obstacles detected by the obstacle detecting apparatus under conditions that the target 
obstacle has been recognized as a moving object by the object recognizing means and the components of the vector 
representing the speed of the target obstacle relative to the vehicle and calculated by the speed calculating means falls 
within the given range. 
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Most obstacle recognized as a moving object by the object recognizing means is a preceding vehicle. In the case 
where a subject vehicle equipped with the obstacle detecting apparatus travels with maintaining a constant distance to 
a preceding vehicle ahead of the subject vehicle, when the subject vehicle and the preceding vehicle travels together 
along a straight section of a road, relative position between both vehicles hardly changes. In this case» the preceding 

5 vehicle is detected straight ahead of the subject vehicle. Therefore, the first deflection calculating means calculates the 
deflection of central axis of the obstacle detecting apparatus on the basis of the angle of the target obstacle detected 
by the object detecting apparatus as long as the target obstacle is estimated to be the preceding vehicle. For example, 
if the detected angle of the target obstacle is directed to the fonward direction of the subject vehicle, the central axis of 
the obstacle detecting apparatus is regarded as not deflecting, so that the deflection value becomes zero. On the other 

10 hand, if the angle deviates from the forward direction of the subject vehicle, the central axis is regarded as deflecting by 
an angle represented by the deviation. 

The deflection of central axis calculating apparatus is able to calculate the deflection of central axis of the obstacle 
detecting apparatus relative to the subject vehicle to facilitate correction of the central axis of the obstacle detecting 
apparatus. Specifically, in the deflection of central axis calculating apparatus according to the first aspect of the present 

15 invention, the deflection of central axis of the obstacle detecting apparatus relative to the subject vehicle is calculated 
from only data related to the target obstacle (preceding vehicle), which is selected from among obstacles detected by 
the obstacle detecting apparatus under conditions that the preceding vehicle has a vector of a relative speed the com- 
ponents of which falls within the given range, so that other data related to moving objects other than the preceding vehi- 
cle and data representing the preceding vehicle during cornering, can be eliminated properly, thereby improving the 

20 accuracy in calculating the deflection. 

The given range may be defined for one of the components of the vector representing the speed of the target obsta- 
cle relative to the subject vehicle, for each of the components, or for a norm. 

A second aspect of the present invention provides a deflection of central axis calculating apparatus which is used 
for an obstacle detecting apparatus mounted on a vehicle, the obstacle detecting apparatus serving to radiate a trans- 

25 mission wave over a given angular range along a central axis thereof for detecting a distance to and an angle of an 
obstacle, and which comprises, as shown in Fig. 15B. object recognizing means for determining whether the obstacle 
is a stationary object or a moving object on the basis of changes in distance to and angle of the obstacle detected by 
the obstacle detecting apparatus; speed calculating means for calculating a vector representing a ^eed of the obstacle 
relative to the vehicle; and second deflection calculating mean, when a target obstacle is selected from among ot>sta- 

30 cles detected by the obstacle detecting apparatus under conditions that the target obstacle has been recognized as a 
stationary object by the object recognizing means and the distance thereto detected by the obstacle detecting appara- 
tus is less than a given value, which calculates the deflection of central axis of the obstacle detecting apparatus relative 
to the vehicle on the basis of the direction of the vector representing the relative speed of the target obstacle calculated 
by the speed calculating means. 

35 In the deflection of central axis calculating apparatus according to the second aspect of the present invention, the 
second deflection calculating means calculates a deflection of central axis of the obstacle detecting apparatus on the 
basis of the direction of the vector representing the speed of the target obstacle relative to the vehicle calculated by the 
speed calculating means, the target obstacle being selected from among obstacles detected by the obstacle detecting 
apparatus under conditions that the target obstacle has been recognized as a stationary object by the object recogniz- 

40 ing means and the distance thereto detected by the obstacle detecting apparatus is less than the given value. 

The vector representing the speed of the stationary object relative to the vehicle has a direction in parallel to the 
longitudinal (forward) direction of the vehicle. Therefore, the second deflection calculating means calculates the deflec- 
tion of central axis of the obstacle detecting apparatus on the basis of the direction of the vector representing the speed 
of the target obstacle (corresponding to the stationary object) relative to the vehicle. For example, if the vector of the 

45 relative speed calculated by the speed calculating means is in parallel to the longitudinal direction, the central axis of 
the obstacle detecting apparatus is regarded as not deflecting, so that the deflection value becomes zero. On the other 
hand, if the direction deviates from the longitudinal direction of the vehicle, the central axis is regarded as deflecting by 
an amount of deviation. Accordingly, the deflection of central axis calculating apparatus is able to calculate the deflec- 
tion of central axis of the obstacle detecting apparatus relative to the vehicle to facilitate correction the central axis of 

so the obstacle detecting apparatus. 

When the vehicle travels straight along a road, the vector of the speed of the stationary object relative to the vehicle 
is completely in parallel to the longitudinal direction of the vehicle. On the other hand, when the vehicle has entered a 
curve, the farther the stationary object from the vehicle, the larger the angle between the longitudinal direction of the 
vehicle and the direction represented by the vector of the relative speed of the stationary object. Therefore, the second 

55 deflection calculating means calculates the central axis of the obstacle detecting apparatus from only data related to 
the obstacle (stationary object) the distance of which is less than the given value, so that the calculation of the deflection 
can be made with a remarkably high accuracy. 

A third aspect of the present invention is based on the first aspect of the present invention, and provides a deflec- 
tion of central axis calculating apparatus which further comprises third deflection calculating means, when a target 
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obstacle is selected from among obstacles detected by the obstacle detecting apparatus under a condition that the tar- 
get obstacle has been recognized as a stationary object by the object recognizing means, which calculates the deflec- 
tion of central axis of the obstacle detecting apparatus relative to the vehicle on the basis of the direction of the vector 
representing the relative speed of the target obstacle calculated by the speed calculating means. 

5 As previously described, the direction of the vector representing the speed of the stationary object relative to the 

vehicle is in parallel to the longitudinal (forward) direction of the vehicle. Therefore, the third deflection calculating 
means calculates the deflection of the central axis of the obstacle detecting apparatus on the basis of the direction of 
the vector representing the speed of the target obstacle (corresponding to the stationary object) relative to the vehicle. 
The use of the third deflection calculating means allows calculating the deflection of the central axis of the obstacle 

10 detecting apparatus even when no moving object such as preceding vehicle is present. In contrast, when a plurality of 
vehicles travels ahead of the subject vehicle, and no stationary object such as road-side thing can be detected because 
such a stationary object is hidden by the vehicles ahead of the subject vehicle, the first deflection calculating means 
calculates the deflection of the central axis of the obstacle detecting apparatus. Thus, the deflection of central axis cal- 
culating apparatus according to the third aspect of the present invention can calculate the deflection of the central axis 

15 in most cases Irrespective of the road conditions, and this gives an advantage over the apparatus according to the first 
aspect of the present invention. 

In addition, the second deflection calculating means according to the second aspect of the present Invention is one 
form of the third deflection calculating means. The third deflection calculating means has a wider range of selection of 
a target obstacle than the second deflection calculating means, in which the target object is selected irrespective of the 

20 distance to the target obstacle. 

A fourth aspect of the present invention is based on the first or third aspect of the present invention, and provides 
a deflection of central axis calculating apparatus, wherein when a target obstacle is selected, from among obstacles 
continuously detected for a given time period or more by the obstacle detecting apparatus, under conditions the target 
obstacle has been recognized as a moving object by the object recognizing means and the components of the vector 

25 representing the relative speed thereof calculated by the speed calculating means falls within a given range, the first 
deflection calculating means calculates the deflection of central axis of the obstacle detecting apparatus relative to the 
vehicle on the basis of the angle of the target obstacle detecting by the obstacle detecting apparatus. That is, in addition 
to the conditions of the first deflection calculating means according to the first or third aspect of the present invention 
that (1) the target obstacle is a moving object and (2) the components of the vector representing the relative speed falls 

30 within the given range, the first deflection calculating means according to the fourth aspect of the present invention fur- 
ther includes a condition that (3) the target obstacle has been continuously detected for the given time period or more. 

The first deflection calculating means according to the fourth aspect of the present invention allows calculating the 
deflection of central axis of the obstacle detecting means from only data related to a preceding vehicle traveling ahead 
of the subject vehicle for a long time without taking into account other data related to moving objects temporarily 

35 detected (e.g., a vehicle traveling along an adjacent lane). Therefore, the deflection of central axis calculating apparatus 
according to the fourth aspect of the present invention can improve the accuracy in calculating the deflection more than 
the apparatus according to the first or third aspect of the present invention. 

A fifth aspect of the present invention is based on any one of the first, third and fourth aspects of the present inven- 
tion, and provides a deflection of central axis calculating apparatus which further comprises width calculating means for 

40 calculating a width of an obstacle on the basis of the distance to and angle of the obstacle detected by the obstacle 
detecting apparatus, wherein when a target obstacle is selected from among obstacles detected by the obstacle detect- 
ing apparatus under corxlltions that the target obstacle has been recognized as a moving object by the object recogniz- 
ing means, the components of the vector representing the relative speed thereof calculated by the speed calculating 
means falls within a given range, and the width thereof calculated by the width calculating means falls within a given 

45 range, the first deflection calculating means calculates the deflection of central axis of the obstacle detecting apparatus 
relative to the vehicle on the basis of the angle of the target obstacle detected by the obstacle detecting apparatus. In 
other words, the first deflection calculating means according to the fifth aspect of the present invention further includes 
a condition that the width of the target obstacle is a given width or narrower in addition to the conditions of the first 
deflection calculating means according to any one of the first, third and fourth aspect of the present invention. 

50 In general, two reflectors are provided on the rear of a vehicle such as a private car or a passenger car. In the case 
where the width calculating means detects and recognizes a distance between the reflectors as the width of the obsta- 
cle (preceding vehicle), when one of the reflectors of the preceding vehicle is dirty, the width of the preceding vehicle 
may be calculated narrower than the actual width. Similarly, in the case where the obstacle detecting apparatus detects 
a two-wheeled vehicle such as a bike, the width of the obstacle becomes narrow. In both cases, the center of the obsta- 

55 cle tends to deviate left or right from the center of the lane. Such data are inappropriate for calculating the deflection of 
central axis of the obstacle detecting apparatus. It is therefore desirable to leave the data out of consideration. In con- 
trast, in the case where the obstacle detecting means detects and recognizes a preceding vehicle on the subject vehi- 
cle's lane and a preceding vehicle on an adjacent lane as an obstacle, the width of the obstacle calculated by 
calculating means becomes wide. In this case, the center of the olDStacle deviates from the center of the subject vehi- 
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cle's lane toward the adjacent lane. It is therefore desirable to leave the data out o1 consideration as well. 

To avoid such situations, the first deflection calculating means according to the fifth aspect of the present invention 
uses a target obstacle as a criterion, which is a moving object and the width of which is within a given range (e.g., a 
range of generally accepted vehicle widths including typical cars), so that the data, such as data related to a two- 
5 wheeled vehicle, data related to a vehicle one reflector of which cannot be detected, and data related to a vehicle 
traveling along the adjacent lane, can be eliminated properly from the data related to the target obstacle. Therefore, the 
deflection of central axis calculating apparatus according to the fifth aspect of the present invention can improve the 
accuracy in calculating the deflection more than the apparatus according to any one of the first, third and fourth aspects 
of the present invention. 

10 A sixth aspect of the present invention is based on any one of the first, third, fourth and fifth aspects of the present ' 
invention, and provides a deflection of central axis calculating apparatus which further comprises average value calcu- 
lating means for calculating a mean or average value of a plurality of deflections of central axis each of which is individ- 
ually calculated as a result of plural calculation cycles of the first deflection calculating means; standard deviation 
calculating means for calculating a standard deviation of the plurality of deflections; and a deflection evaluating means 

15 for evaluating the average value of the plurality of deflections to be a reliable value for the deflection of central axis of 
the obstacle detecting apparatus relative to the vehicle when the standard deviation of the plurality of deflections is 
smaller than a given value and the number of deflections upon which the average value and the standard deviation are 
calculated is a given number or more, or for evaluating the value of each deflection and the average value of the plurality 
of deflections to be unreliable values when the standard deviation is the given value or larger and the number of deflec- 

20 tions is less than the given number. 

In the case where the first deflection calculating means calculates the deflections individually as a result of plural 
calculation cycles, when the number of deflections is many enough and the standard deviation is small enough, the 
average value of the deflections is regarded as close enough to an actual deflection. Therefore, the deflection evaluat- 
ing means evaluates the average value of the deflections to be a reliable value for the deflection of central axis of the 

25 obstacle detecting apparatus relative to the vehicle when the standard deviation of the plurality of deflections is smaller 
than the given value and the number of deflections is the given number or more. On the other hand, the deflection eval- 
uating means evaluates the value of each deflection and the average value of the deflections to be unreliable values 
when the standard deviation is the given value or larger and the number of deflections is less than the given number. 
Accordingly, the deflection of central axis calculating apparatus according to the sixth aspect of the present invention 

30 can improve the accuracy in calculating the deflection more than the apparatus according to any one of the first, third, 
fourth and fifth aspects of the present invention. In addition, the deflection evaluating means allows determining, on the 
basis of the result of Valuation, whether or not the calculated deflection is should be considered in control processes 
such as a control process of correcting the central axis of the obstacle detecting apparatus, thereby properly improving 
reliability of the control. 

35 A seventh aspect of the present invention provides a deflection of central axis calculating apparatus including the 
second deflection calculating means or the third deflection calculating means as set forth in any one of the second 
through sixth aspects of the present invention, which further comprises average value calculating means for calculating 
a mean or average value of a plurality of deflections of central axis each of which is individually calculated as a result 
of plural calculation cycles of the second or third deflection calculating means; standard deviation calculating means for 

40 calculating a standard deviation of the plurality of deflections; and deflection evaluating means for evaluating the aver- 
age value of the plurality of deflections to be a reliable value for the deflection of central axis of the obstacle detecting 
apparatus relative to the vehicle when the standard deviation is smaller than a given value and the number of deflect 
ions upon which the average value and the standard deviation are calculated is a given number or more, or for evaluat- 
ing the value of each deflection and the average value of the plurality of deflections to be unreliable values when the 

45 standard deviation is the given value or larger and the number of deflections is less than the given number. 

As configured such above, the deflection of central axis calculating apparatus according to the seventh aspect of 
the present invention can improve the accuracy in calculating the deflection more than the apparatus according to any 
one of the second through sixth aspects of the present invention each of which includes the second deflection calculat- 
ing means or the third deflection calculating means. In addition, the deflection evaluating means allows determining, on 

50 the basis of the result of evaluation, whether or not the calculated deflection is should be considered in control proc- 
esses such as a control process of correcting the central axis of the obstacle detecting apparatus, thereby properly 
improving reliability of the control. 

An eighth aspect of the present invention provides a deflection of central axis calculating apparatus including both 
the first deflection calculating means and the third deflection calculating means as set forth in any one of the third 

55 through seventh aspects of the present invention, wherein when an absolute value of the deflection calculated by the 
third deflection calculating means is a given value or larger, the value of the deflection calculated by the first deflection 
calculating means is neglected. 

The first deflection calculating means detects a preceding vehicle on the assumption that the preceding vehicle 
travels along the subject vehicle's lane. Therefore, in the case where the deflection of central axis of the obstacle detect- 
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ing apparatus is so large that the subject vehicle's lane deviates from the detection zone of the obstacle detecting appa- 
ratus, the obstacle detecting apparatus cannot detect any preceding vehicle, and hence the first deflection calculating 
means cannot determine the deflection of central axis of the obstacle detecting apparatus, or may determine an error 
value of the deflection on the basis of data related to a vehicle traveling along the adjacent lane. On the contrary, the 
5 third deflection calculating means is able to determine the reliable value of the deflection as long as the obstacle detect- 
ing apparatus detects at least one stationary object present on the left or right side of the road even if the deflection of 
central axis of the obstacle detecting apparatus is too large to detect an obstacle or obstacles on the subject vehicle's 
lane. 

For this reason, the deflection of central axis calculating apparatus according to the eighth aspect of the present 

10 invention neglects the value of the deflection calculated by the first deflection calculating means when the value of the 
deflection calculated by the third deflection calculating means is the given value or larger, and this makes it possible to 
calculate the deflection accurately even when the deflection of central axis of the obstacle detecting apparatus is rela- 
tively large. Accordingly, the deflection of the central axis calculating apparatus according to the eighth aspect of the 
present Invention can Improve the accuracy in calculating the deflection more than the apparatus according to any one 

15 of the third through seventh aspects of the present invention each of which Includes both the first deflection calculating 
means and the third deflection calculating means. 

A ninth aspect of the present invention is based on any one of the first through eighth aspects of the present inven- 
tion, and provides a deflection of central axis calculating apparatus which further comprises straight advancement 
determining means for determining whether or not the vehicle is traveling straight, wherein the first, second or third 

20 deflection calculating means calculates the deflection only when the straight advancement determining means deter- 
mines that the vehicle is traveling straight. In other words, a corKjition, provided by the straight advancement determin- 
ing means, whether or not the vehicle is traveling straight, is added to the deflection calculating conditions upon which 
the deflection is calculated by the first, second or third deflection calculating means according to any one of the first 
through eighth aspects of the present Invention. 

25 If the subject vehicle is traveling straight, a moving object or preceding vehicle will be present straight ahead of the 
subject, while a vector representing the speed of a stationary object relative to the subject vehicle will have a direction 
exactly equal to the forward direction of the subject vehicle. Therefore, the deflection of central axis calculating appara- 
tus according to the ninth aspect of the present invention can improve the accuracy in calculating the deflection more 
than the apparatus according to any one of the first through eighth aspects of the present Invention. 

30 A tenth aspect of the present Invention provides an apparatus for correcting a deflection of central axis of an obsta- 
cle detecting apparatus, which comprises angle correcting means for correcting the angle of the obstacle detected by 
the obstacle detecting apparatus on the basis of the value of the deflection calculated by the deflection of central axis 
calculating apparatus of any one of the first through ninth aspects of the present invention. 

In the deflection of central axis correcting apparatus according to the tenth aspect of the present invention, the 

35 angle correcting means corrects the angle of the ot^stacle relative to the vehicle detected by the obstacle detecting 
apparatus on the basis of the value of the deflection calculated by the deflection of central axis calculating apparatus, 
so that the central axis of the obstacle detecting apparatus can be adjusted substantially to the centerline of the vehicle 
along the longitudinal direction, thereby improving the accuracy In control processes such as an inter-vehicle distance 
control process and a warning control process. 

40 An eleventh aspect of the present invention is based on the tenth aspect of the present invention, and provides a 
deflection of central axis correcting apparatus, wherein the obstacle detecting apparatus comprises transmitting means 
for radiating a transmission wave every given angle In a scanning manner; receiving means for receiving a reflected 
wave from an obstacle; distance calculating means for calculating a distance to the obstacle on the basis of an interval 
of time between the moment of transmission of the transmission wave by the transmitting means and the moment of 

45 reception of the reflected wave by the receiving means; and storage means for storing data representing the distance 
to the obstacle provided by the distance calculating means with maintaining the one-to-one correspondence between 
the distance to the obstacle and the angle of radiation at which the corresponding transmission wave is radiated, such 
that the angle correcting means corrects the angle of the obstacle relative to the vehicle by changing the correspond- 
ence or the relation between the distance to the obstacle and the angle of radiation stored in the storage means. 

so In this type of obstacle detecting apparatus, the data representing the distance to the obstacle is stored in the stor- 
age means in correspondence with data representing the angle of radiation, so that the distance to and angle of the 
obstacle can be detected on the basis of both data. Further, the angle of the obstacle can be easily corrected In a simple 
process such as a process of changing the correspondence or the relation by means of data shift or the like. The angle 
correcting means thus corrects the angle of the obstacle relative to the vehicle by changing the correspondence or the 

55 relation. Accordingly, the deflection of central axis correcting apparatus according to the eleventh aspect of the present 
invention can simplify and speed up the data processing to be executed by the angle correcting means more than the 
apparatus according to the tenth aspect of the present invention. 

A twelfth aspect of the present invention is based on the tenth or eleventh aspect of the present invention, and pro- 
vides a deflection of central axis correcting apparatus which further comprises coordinate transforming means for trans- 
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forming the distance to and angle of the obstacle detected by the obstacle detecting apparatus into a position of 
orthogonal coordinates by solving a given equation for coordinate transformation, such that the angle correcting means 
corrects the angle of the obstacle relative to the vehicle by changing or alternating the equation for coordinate transfor- 
mation provided by the coordinate transformation means. 

5 The coordinate transformation means determines a position of the obstacle on the plane of the orthogonal coordi- 

nates by solving the distance to and angle of the obstacle (i.e., polar coordinates) according to the given equation. In 
such a coordinate transformation, the angle of the obstacle relative to the vehicle can be changed in the orthogonal 
coordinate system by changing or alternating the given equation. Therefore, the deflection of central axis correcting 
apparatus according to the twelfth aspect of the present invention can correct the angle of the obstacle relative to the 

10 vehicle more accurately than the apparatus according to the tenth or eleventh aspect of the present invention. 

A thirteenth aspect of the present invention provides an inter-vehicle distance control system which includes an 
obstacle detecting apparatus for a vehicle serving to radiate a transmission wave over a given angular range along the 
central axis thereof for detecting a distance to and an angle of an obstacle; preceding vehicle selecting means for 
selecting a preceding vehicle from among obstacles detected by the obstacle detecting apparatus, the preceding vehi- 

15 cle corresponding to a target obstacle for which inter-vehicle distance control should be executed; and inter-vehicle dis- 
tance control means for controlling the speed of the subject vehicle equipped with the system to hold a distance 
between the subject vehicle and the preceding vehicle selected by the preceding vehicle selecting means; the inter- 
vehicle distance control system comprising: an apparatus for calculating a deflection of central axis according to any 
one of the first through ninth aspects of the present invention, which calculates a deflection of central axis of the obsta- 

20 cle detecting apparatus; and control condition changing means for changing the control condition of the inter-vehicle 
distance control means on the basis of the value of the deflection calculated by the deflection of central axis calculating 
apparatus. 

In the inter-vehicle distance control system according to the thirteenth aspect of the present invention, the preced- 
ing vehicle selecting means selects a preceding vehicle, for which the inter-vehicle distance control should be executed, 

25 from among obstacles detected by the obstacle detecting apparatus The inter-vehicle distance control means then 
adjusts the speed of the subject vehicle to control a distance to the preceding vehicle selected by the preceding vehicle 
selecting means so that the subject vehicle can travel with maintaining a constant distance to the preceding vehicle. 

Further, the deflection of central axis calculating apparatus calculates the deflection of central axis of the obstacle 
detecting apparatus, while the control condition changing means changes the control condition of the inter-vehicle dis- 

30 tance control means on the basis of the value of the deflection calculated by the deflection of central axis calculating 
apparatus. Therefore, even when the central axis of the obstacle detecting apparatus deflects from the centerline of the 
subject vehicle along the longitudinal direction, the control condition changing means prevents the deflection of central 
axis from being used directly as a condition for inter-vehicle distance control, so that the control safety can be improved. 
As previously described, the control condition can be changed by correcting the angle of the obstacle relative to the 

35 subject vehicle. The control condition may be also changed by changing acceleration or deceleration, as described 
later, or by keeping the distance between vehicles long. 

A fourteenth aspect of the present invention is based on the thirteenth aspect of the present invention, and provides 
an inter-vehicle distance control system, wherein the control condition changing means changes the value of accelera- 
tion/deceleration of the subject vehicle to be adjusted by the inter-vehicle distance control means in response to the 

40 value of the deflection calculated by the deflection of central axis calculating apparatus. 

The condition changing means according to the fourteenth aspect of the present invention prevents the deflection 
of central axis from being directed used as a value of the acceleration/deceleration of the subject vehicle. Therefore, the 
inter-vehicle distance control system according to the fourteenth aspect of the present invention can improve the control 
safety more than the system according to the thirteenth aspect of the present invention. In addition, the value of the 

45 acceleration/deceleration of the subject vehicle may be changed by reducing the value of the acceleration/deceleration 
of the subject vehicle, as described later, or by correcting or directing the value of the acceleration/deceleration of the 
subject vehicle to the decelerated side as a whole. 

A fifteenth aspect of the present invention is based on the fourteenth aspect of the present invention, and provides 
an inter-vehicle distance control system, wherein the control condition changing means reduces the value of the accel- 

50 eration/deceleration of the subject vehicle to be adjusted by the inter-vehicle distance control means in response to the 
value of the deflection calculated by the deflection of central axis calculating apparatus. 

In the case where the central axis of the obstacle detecting apparatus deflects from the centerline of the subject 
vehicle along the longitudinal direction, the control condition changing means is able to reduce the value of the accel- 
eration/deceleration of the subject vehicle to be adjusted by the inter-vehicle distance control means. The control con- 

55 dition changing means allows preventing the subject vehicle from being excessively accelerated or decelerated in 
response to the value of the deflection of central axis of the obstacle detecting apparatus, so that the subject vehicle 
can continue to travel stably Therefore, the inter-vehicle distance control system according to the fifteenth aspect of the 
present invention can improve the safety more than the system according to the fourteenth aspect of the present inven- 
tion. 
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A sixteenth aspect of the present invention is based on the thirteenth aspect of the present invention, and provides 
an inter-vehicle distance control system, wherein the control condition changing means stops the control processing to 
be executed by the inter-vehicle distance control means in response to the value of the deflection calculated by the 
deflection of central axis calculating apparatus. 

5 In the case where the central axis of the obstacle detecting apparatus deflects from the centerline of the subject 

vehicle along the longitudinal direction, the control condition changing means Is able to stop the control processing to 
be executed by the inter-vehicle distance control means. Therefore, the inter-vehicle distance control system according 
to the sixteenth aspect of the present invention can improve the safety more than the system according to the thirteenth 
aspect of the present invention. 

10 A seventeenth aspect of the present invention is based on the sixteenth aspect of the present invention, and pro- 
vides an inter-vehicle distance control system which further comprises sudden-change detecting means for detecting a 
sudden change in deflection of central axis of the obstacle detecting apparatus, such that the control condition changing 
means stops the control processing to be executed by the inter-vehicle distance control means when a sudden change 
in deflection of central axis of the obstacle detecting apparatus is detected by the sudden-change detecting means. 

15 The sudden-change detecting means detects a sudden change in deflection of central axis of the obstacle detect- 
ing apparatus. In general, such a sudden change occurs, for example, when a fixing member (or members) such as a 
screw comes off the obstacle detecting apparatus, or when something runs against the obstacle detecting apparatus or 
near elements to cause deformation to the obstacle detecting apparatus. In these cases, it is undesirable to continue 
the inter-vehicle distance control processing. To this end, the control condition changing means according to the sev- 

20 enteenth aspect of the present invention stops the control processing to be executed by the inter-vehicle distance con- 
trol means when a sudden change in deflection is detected by the sudden-change detecting means. Therefore, the 
inter-vehicle distance control system according to the seventeenth aspect of the present invention can improve the 
safety more than the system according to the sixteenth aspect of the present invention. 

25 BRIEF DESCRIPTION OF THE DRAWINGS 

These objects and features of the present invention will become more readily apparent from the following detailed 
description of the preferred embodiments taken in conjunction with the accompanying drawings in which: 

30 Fig. 1 is a block diagram showing a structure of a vehicle control system to which the present invention is applied; 
Fig. 2 is a block diagram showing a structure of a control unit of the vehicle control system; 
Fig. 3 is an illustration explaining how to calculate a deviation of an optical axis on the basis of the position of a pre- 
ceding vehicle; 

Fig. 4 is an illustration explaining how to calculate a deviation of an optical axis on the basis of a vector representing 
35 a speed of a road-side thing relative to a subject vehicle; 

Fig. 5 is a flowchart showing a portion of an optical axis correction process executed by the control unit; 

Fig. 6 is a flowchart showing a continued portion of the optical axis correction process executed by the control unit; 

Fig. 7 is a flowchart showing a remaining portion of the optical axis correction process executed by the control unit; 

Fig. 8 is a flowchart showing a deviation of optical axis calculation routine in the optical axis correction process; 
40 Fig. 9 is a diagram explaining the optical axis correction process executed by a distance/angle measuring device; 

Figs. 10A and lOB are graphs explaining the effect when only a moving object is used as a target obstacle in the 

optical axis correction process; 

Fig. 11 is a flowchart showing an inter-vehicle distance control process executed by the control unit; 
Fig. 12 is a flowchart showing a controllability judgment routine in the inter-vehicle distance control process; 
45 Fig. 13 is a flowchart showing an inter-vehicle distance control routine in the inter-vehicle distance control process; 

Fig. 14 is a flowchart showing an acceleration/deceleration calculation routine in the inter-vehicle distance control 
process; and 

Figs. 15A and 158 are block diagrams each showing an exemplary structure of the present invention. 
so DETAILED DESCRIPTION OF THE INVENTION 

Referring now to the drawings, a vehicle control system 1 according to the present invention will be described. The 
vehicle control system 1 is mounted on a vehicle and serves to issue an alarm or control the speed of the subject vehi- 
cle equipped with the system 1 relative to a vehicle ahead of the subject vehicle (preceding vehicle) when the preceding 
55 vehicle is present in a warning area and satisfies given conditions. 

Rg. 1 is a block diagram showing a system structure. In Fig. 1, a control unit 3 is centered in the vehicle control 
system 1. The control unit 3 is mainly constituted with a microcomputer including an input/output interface (1/0), and 
various driver circuits and detection circuits. Such a hardware structure is well known to those skilled persons and 
therefore the detailed description will be omitted. 
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The control unit 3 is electrically connected to a distance/angle measuring device 5, a vehicle speed sensor 7, a 
brake switch 9 and a throttle position sensor 1 1 . The control unit 3 receives detected data from these devices 5. 7. 9 
and 1 1 constituting an obstacle detecting apparatus for a vehicle. 

The control unit 3 is electrically connected to an alarm sound generator 13, a distance indicator 15, a sensor abnor- 
5 mality indicator 17, a brake driver 19, a throttle driver 21 , and an automatic transmission controller 23. The control unit 
3 outputs drive signals to these devices 13, 15, 17, 19, 21, and 23, respectively 

The control unit 3 is electrically connected to an alarm sensitivity setting device 25 and a steering angle sensor 27. 
The alarm sensitivity setting device 25 serves to set the sensitivity used in a warning judgment process as described 
later. The steering angle sensor 27 serves to detect a steered angle of a steering wheel, not shown. The control unit 3 
10 is electrically connected to a power supply switch 29. When the power supply switch 29 turns to be on-state, the control 
unit 3 starts Its operation. 

The distance/angle measuring device 5 Includes a transmitting/receiving section 31 and a distance/angle calculat- 
ing section 33. The transmitting/receiving section 31 emits a laser light beam forward of the subject vehicle. A given 
angular range ahead of the subject vehicle along a given optica! axis (central axis) Is scanned by the laser light beam. 

15 The transmitting/receiving section 31 then receives a reflect light beam from an object ahead of the subject vehicle. The 
distance/angle calculating section 33 detects the Interval of time between the moment of transmission of the laser light 
beam and the moment of reception of the corresponding reflected light beam in response to an output signal of the 
transmitting/receiving section 31 . The distance/angle calculating section 33 calculates the distance to the object ahead 
of the subject vehicle which caused the reelected light beam. Such a measuring device is well known to those skilled 

20 persons and therefore the detailed description will be omitted. The distance/angle measuring device 5 may use an elec- 
tric wave or ultrasonic wave such as a microwave instead of laser light. Further, the distance/angle measuring device 5 
may adopt a mono-pulsed system instead of the scan type system, in which the transmitting/receiving section 31 has 
two or more receivers and the distance/angle calculating section 33 calculates a distance to and an angle of the object 
ahead of the subject vehicle on the basis of differences in strength and phase (time) between received signals. 

25 The control unit 3 executes a warning judgment processing for Issuing an alarm when an obstacle remains in the 
warning area for a predetermined time or longer. Examples of the obstacle are a moving vehicle which travels ahead of 
the subject vehicle, a stationary vehicle In front of the subject vehicle, and an object at a side of a road such as a guard- 
rail and a pole. The control unit 3 also executes a cruise control processing for controlling the speed of the subject vehi- 
cle according to the state of the vehicle ahead of the subject vehicle. The cruise control processing Is executed by 

30 outputting a drive signal to the brake driver 19, the throttle driver 21 , or the automatic transmission controller 23. 

Fig. 2 is a block diagram showing control blocks of the control unit 3. Data output from the distance/angle measur- 
ing device 5, which represent a calculated distance r and a calculated scan angle 6, are processed by a coordinate 
transformation block 41. Specifically the distance r and the scan angle e is transformed Into values In XY orthogonal 
coordinates the origin (0, 0) of which agrees with a point of the subject vehicle. A sensor abnormality detection block 43 

35 receives the values in the XY orthogonal coordinates from the coordinate transformation block 41 , and determines 
whether or not the values In the XY orthogonal coordinates are In a given abnormal range. When the values in the XY 
orthogonal coordinates are In the given abnormal range, the sensor abnormality detection block 43 actuates the sensor 
abnormality indicator 1 7 to indicate that the distance r and the scan angle 0 provided by the distance/angle measuring 
device 5 are inappropriate or incorrect. 

40 An object recognition block 45 receives the values in the XY orthogonal coordinates from the coordinate transfor- 
mation block 41 , and recognizes and decides the type of the fonward object, the width W, and the coordinates (X, Y) of 
the position of the center of the forward object In response to the values in the XY orthogonal coordinates. The type of 
the forward object is used to determine whether the fbn/vard object is a stationary object or a moving object. A distance 
indicated object selection block 47 following the object recognition block 45 determines whether or not the forward 

45 Object has a given or higher chance of interference with the travel of the subject vehicle on the basis of the position of 
the center of the forward object. When the fbnward object has the given or higher chance of interference with the travel 
of the subject vehicle, the distance indicated object selection block 47 selects the forward object, and actuates the dis- 
tance Indicator 15 to Indicate the distance to the selected forward object. 

The output of the vehicle speed sensor 7 is processed by a vehicle speed calculation block 49. The vehicle speed 

50 calculation block 49 calculates the speed V of the subject vehicle from the output of the vehicle speed sensor 7. A rel- 
ative speed calculation block 51 following both the object recognition block 45 and the vehicle speed calculation block 
49 calculates the speed of the forward object (forward vehicle) relative to the subject vehicle and determines the coor- 
dinates (Vx, Vy) of the speed of the forward vehicle relative to the subject vehicle on the basis of the speed V of the 
subject vehicle and the position of the center of the fonward object. A forward vehicle acceleration calculation block 53 

55 then calculates the acceleration of the forward vehicle relative to the position of the subject vehicle on the basis of the 
speed of the subject vehicle and the position of the center of the fonward object. 

A warning judgment and cruise judgment block 55 receives the data pieces representing the speed of the subject 
vehicle, the speed of the forward vehicle relative to the subject vehicle, the acceleration of the fonward vehicle relative 
to the position of the subject vehicle, the position of the center of the fonward object, the width of the forward object, and 
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the type of the forward object. The warning judgment and cruise judgment block 55 also receives the output of the brake 
switch 9. the data and output from the throttle position sensor 1 1 representing the position of the throttle, and the data 
output from the alarm sensitivity setting device 25 and representing the set value of the alarm sensitivity. In the warning 
judgment, the warning judgment and cruise judgment block 55 determines whether or not an alarm should be gener- 

5 ated by referring to the received information. In the cruise judgment, the warning judgment and cruise judgment block 
55 determines how to control the speed of the subject vehicle by referring to the received information. When an alarm 
is required, the warning judgment and auise judgment block 55 outputs an alarm generation signal to the alarm sound 
generator 13. When the cruise control should be executed, the warning judgment and cruise judgment block 55 outputs 
control signals to the automatic transmission controller 23, the brake driver 19, and the throttle driver 21, respectively 

10 to perform necessary control. 

The control unit 3 further includes an optical axis correction block 61 for correcting the optical axis of the dis- 
tance/angle measuring device 5. The optical axis correction block 61 receives the data pieces representing the speed 
of the subject vehicle, the speed of the fonward vehicle relative to the subject vehicle, the position of the center of the 
fonward object, the width of the forward object, and the type of the forward object. The optical axis correction block 61 

15 also receives a data piece from a curvature radius calculation block 63. The curvature radius calculation block 63 serves 
to calculate the curvature radius R of a curve along which the subject vehicle travels on the basis of the speed of the 
subject vehicle and the output of the steering angle sensor 27. The optical axis correction block 61 calculates the devi- 
ation of the optical axis (the deflection of the central axis of the distance/angle measuring device 5) on the basis of the 
received data pieces and the curvature radius R fed from the curvature radius calculation block 63. Furthermore, the 

20 control unit 3 includes a nonvolatile memory 67. The nonvolatile memory 67 stores all the data to be used by the optical 
axis correction block 61 for calculating the deviation of the optical axis. The optical axis correction block 61 then outputs 
signals to the distance/angle measuring device 5 and the coordinate transformation block 41 so that the calculated devi- 
ation of the optical axis will be corrected- The signals output from the optical axis correction block 61 to the dis- 
tance/angle measuring device 5 and the coordinate transformation block 41 will be described later. 

25 A description will be made next to the optical axis correction process executed by the optical axis correction block 
61. The optical axis correction process is a process for calculating the deviation of the optical axis on the basis of the 
data pieces and the curvature radius R. as cited above, and correcting the calculated deviation of the optical axis. 

Figs. 3 and 4 are illustrations explaining how to calculate the deviation of the optical axis. Fig. 3 shows a case where 
the deviation of the optical axis is calculated on the basis of the position of the fonward vehicle, while Fig. 4 shows a 

30 case where the deviation of the optical axis is calculated on the basis of the vector representing the speed of the road- 
side object relative to the subject vehicle. 

As shown in Fig. 3, when the subject vehicle 91 travels along the straight section of the road, most obstacle recog- 
nized as a moving object is a vehicle (preceding vehicle) 93 ahead of the subject vehicle 91 . Therefore, the preceding 
vehicle 93 is detected in a position straight ahead of the subject vehicle 91 . If the optical axis 95 of the transmit- 

35 ting/receiving section 31 of the distance/angle measuring device 5 is oriented straight ahead of the subject vehicle 91 , 
the preceding vehicle 93 will be detected on the optical axis 95. On the other hand, when the optical axis 95 deviates 
from the central axis of the vehicle, the preceding vehicle 93 is detected in a position deviated from the optical axis 95 
by an angle em. In this case, the value e of deflection of optical axis 95 is equal to ■ Om. 

As shown in Fig. 4, when the subject vehicle 91 travels along the straight section of the road, the vector V repre- 

40 senting the relative speed of a road-side object 97 recognized as a stationary object is in parallel to the fonward direction 
of the subject vehicle 91. Therefore. If the optical axis 95 of the transmitting/receiving section 31 of the distance/angle 
measuring device 5 Is oriented straight ahead of the subject vehicle 91 , the optical axis 95 and the vector V representing 
the relative speed of the road-side object 97 will be In parallel to each other. On the other hand, when the optical axis 
95 deviates from the forward direction of the subject vehicle 91 , the optical axis 95 and the vector V intersect with each 

45 other at an angle Os. The angle es corresponds to the angle of the optical axis 95 deviated from the forward direction of 
the subject direction. In this case, the value 0 of the deflection of optical axis 95 is equal to - es. 

Figs. 5 to 7 are flowchart showing the optical axis correction process. The following description will be made on the 
assumption that the optical axis correction block 61 repeats the optical axis correction process every execution cycle of 
200 ms after the power supply switch 29 turns to be on-state, the distance data output from the distance/angle meas- 

50 uring device 5 has a value ranging from 0 m to 150 m (resolution 0.1 m), and the angle data output from the dis- 
tance/angle measuring device 5 has a value ranging from -8 deg to 8 deg (resolution 0.5 deg). 

The optical axis correction process has a first step SI 0 (herelnbelow. the term "step" may be marked by "S"). S1 0 
calculates the angles em and es. As previously described, the angle em represents the deviation of the optical axis (and 
- em represents an instantaneous value of the deviation of the optical axis), while th" angle es represents the deviation 

55 of the optical axis (and - es represents an instantaneous value of the deviation of the optical axis). The angles em and 
es are not calculated for all the obstacles. The angles em and es are calculated by the following deviation of optical axis 
calculation routine on the basis of given conditions. 

Flg. 8 is a flowchart showing the deviation of optical axis calculation routine. In the routine, it is determined whether 
or not the following conditions 1) and 2) are satisfied (S101, Si 03). 
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1) I curvature radius | > 1500 m (S101) 

2) Speed of subject vehicle V > 40 km/h (Si 03) 

In the case where either of the conditions 1) and 2) is not satisfied, i.e., in the case where a NO answer is obtained 
5 in S101 or Si 03, the routine ends without calculating both the angles Om and Gs. After that, the program advances to 
S20 (Fig. 5) in which a statistical processing is executed. On the other hand, in the case where both of the conditions 
1) and 2) are satisfied, i.e., in the case where YES answers are obtained in Si 01 and 8103, the program advances from 
SI 03 to SI 05. In Si 05, it is determined whether or not there is at least one moving object such that all the following 
conditions are satisfied. 

10 

The moving object has been continuously detected for five seconds or more. If a plurality of moving objects contin- • 
uously detected for five seconds or more are present, the moving object closest to the subject vehicle 91 is selected 
as a target object from among the plurality of moving objects. 

The speed (Vx, Vy) of the moving object relative to the subject vehicle 91 have lately satisfied the following condi- 
15 tion continuously for one second: 

[l Vx i<l. 0 + [km/h] 
/ I V y I ^7. 5 [km/h] 



The width of the moving object takes a value ranging from 1 .2 m to 2.8 m. 

25 

In the case where there is at least one moving object such that all the above conditions are satisfied, i.e., an YES 
answer is obtained in S105, the program advances to SI 07. In SI 07, the angle em is calculated from the coordinates 
(X, Y) of the position of the center of the corresponding moving object by solving the following equation. 

30 0m = (XAO • (180/7t) [deg] 

After S107, the program advances to S1 1 1 . 

On the other hand, in the case where there is no moving object such that all the above condition are satisfied, i.e., 
a NO answer is obtained in Si 05, the program jumps to S1 1 1 . In S1 1 1 , it is determined whether or not there is at least 
35 one stationary object such that both of the following conditions are satisfied. 

The stationary object has been continuously detected for one second or more. 
The Y coordinate of the stationary object Is equal to or less than 40 m. 

40 In the case where there is at least one stationary object such that both the conditions are satisfied, i.e., in the case 
where an YES answer is obtained in S1 1 1 , the program advances to S1 13. In Si 13, the angle 0s is calculated from the 
speed (Vx, Vy) of the corresponding stationary object relative to the subject vehicle 91 by solving the following equation. 

es= (VxA/y) - (ISO/ti) [deg] 

45 

After S1 1 3, this routine ends and the program returns to S20. 

On the other hand, in the case where there is no stationary object such that both the conditions are satisfied, i.e., 
in the case where a NO answer in obtained in S1 1 1 , this routine ends and the program returns to S20. 

Returning to Fig. 5, S20 executes the statistical processing with respect to the calculated angles 0m and Os in the 
50 following manner. 

For the angle 0m, 

Nm-Nm+1 

Nm Nm-1 

Vem- y 0m+em 
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Nm Nm-1 

avem=zem/Nm 
am ^={sem ^-(lem) ^/Nm}/Nm 



10 In this processing, "1 " is added to the number of data Nm representing the angle Om, the current angle Om and a square 
of the current angle em2 are added to values Om and em2 representing the total sum of the previous angles Om and 
squares of the previous angles em2. a mean or average value av Om (hereinbelow, the mark "av" denotes mean or aver- 
age) and a square of a standard deviation am2 of the angles Om are calculated on the basis of the updated Nm. sem, 
and SOm^. 

15 Similarly, for the angle 6s, 

Ns-Ns+1 

Nm Nm-1 

^es- ^ es+es 

Nm Nm-1 

^os^- es^+es^ 

25 

av0s=res/Ns 



as^={zes^-(I0s) ^/Ns}/Ns 



30 



In this processing, the calculation is made with respect to the following values: Ns, IBs, zes^, av Os, and as^. 

After S20, the program advances to S25. In S25, all the angles Om and Os are united on the basis of the total 
amount of statistics of the angles Om and 0s calculated by S20. In other words, S25 calculates a representative value 
0tot of the angles 8m and es separately calculated by S20 and the number of corresponding data Ntot. The calculation 
35 is made by determining whether or not the following conditions are satisfied. 

Condition A : | -avOs - 0shift | ^ 6.0 deg and Ns ^ 20 
Condition B : as < 1.5 deg 
Condition C : Nm ^ 30 and C7m< 0.85 deg 
40 Condition D : Ns ^ 20 and as < 1 .1 5 deg 

In the condition A, " Oshift" denotes a value representing the correction value of the optical axis 95 (i.e. , the deviated 
amount of the optical axis 95), which is stored in the nonvolatile memory 67 in a manner described later. The value 
Oshift has a value ranging from 5 to 2.5 deg inclusive. As previously noted, the transmitting/receiving section 31 of the 

45 distance/angle measuring device 5 emits a laser light beam over an angular range of ± 8.0 deg from the optical axis 95 
to both sides of the width direction of the subject vehicle 91 . In this case, the condition A indicates that the deviation of 
the optical axis 95 is too large to fully detect the fonward object. The condition B indicates that the calculated average 
value av Os can be used as a true value of the angle 0s reliably to some degree. The conditions C and D indicate that 
the calculated average values av 0m and av Os can be reliably used as true values of the angles Om and Os, respectively. 

50 In the case where the condition A is not satisfied and the conditions C and D are satisfied, the average values av 

Om and av Os are reliable. Therefore, the representative value Otot and the number of data Ntot are calculated by solving 
the following equations. 

AW -avOm * Nm-avOs * Ns 

cc 0tOt= r~. r: OShrft 

^5 Nm+Ns 



Ntot =Nm+Ns 
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tn the case where the conditions A and D are not satisfied and the condition C is satisfied, the values e tot and Ntot 
are calculated by solving the following equations. 

etot = -av Gm - Oshift 

£ 

Ntot = Nm 

In the case where the conditions A and B are satisfied, or in the case where the conditions A and C are not satisfied 
and the condition D is satisfied, the values etot and Ntot are calculated by solving the following equations. In other 
10 words, when the forward object cannot be detected adequately (condition A), if the fonward object is assumed to be the 
preceding vehicle 93, the value em has a high chance to include an error. In this case, if the average value av 0s is reli- 
able to some degree, the values etot and Ntot are calculated from the average angle av os. Similarly, even when the 
forward object can be detected, if only the average value av es is reliable to some degree, the values etot and Ntot are 
calculated from the average value av es. 

75 

etot = -av es ■ eshift 

Ntot = Ns 

20 In the case where the condition A is satisfied and the condition B is not satisfied, or in the case where the conditions 

A, C and D are not satisfied, the calculation of the representative value etot Is made not obtainable and the number of 
data Ntot is set equal to 0. In other words, when the forward object cannot be detected adequately, if the average value 
av es is not reliable, the calculation of the representative value etot is made not obtainable. Similarly, even when the for- 
ward object can be detected, if both the average values av es and av em are not reliable, the calculation of the repre- 
ss sentative value etot is made not obtainable. 

S31 to S35 following S 25 determine whether or not at least one condition is satisfied among the following condi- 
tions (a) to (c). 

(a) 30 minutes has elapsed since the power switch 29 turned to be on-state, or since the program advanced to S60 
30 in the last execution cycle (S31). 

(b) Nm ^ 600 (S33) 

(c) Ns ^ 400 (S35) 

In the case where at least one condition is satisfied, i.e.. in the case where an YES answer is obtained in any one 
35 of Steps 831 , 833 and 835, the program advances to 860. On the other hand, in the case where all the conditionsrare 
not satisfied, i.e., in the case where NO answers are obtained in all the steps S31 , 833 and 835, the program advances 
to 841 . 

841 to 843 determine whether or not all the following conditions (a) to (c) are satisfied, i.e.. these steps determine 
whether or not the optical axis 95 can be corrected by the correction value eshift calculated from the values em. 

40 

(a) |i:em|^ 150 deg (841) 

(b) Nm^ 150 (842) 

(c) One of the following conditions is satisfied. (843) 

45 A fail flag is off -state (the fail flag will be described later in 860). 
I etot I < 2.5 deg 
The representative value Otot is not obtainable. 

In the case where all the conditions (a) to (c) are satisfied, i.e., in the case where YES answers are obtained in all 
the steps S41 , 842 and S43, the program advances to 844. 
so The values am and | av am j are compared with 0.85 deg and 0.5 deg, respectively, in 844, and the value av em is 
compared with 0 deg in S45. On the basis of the comparisons, the value eshift is corrected as follows. 

(1) When the value crm is equal to or larger than 0.85 deg or the absolute value of the average value av em, (i.e., | 
avem I) is smaller than 0.5 deg, i.e.. when an YES answer is obtained in 844. the program advances to S60 with 

55 maintaining the current value Oshift. 

(2) When the value am is smaller than 0.85 deg and the average value av em is equal to or larger than 0.5 deg, i.e., 
when a NO answer is obtained in S44 and an YES answer is obtained in 845. the program advances to 847. In 
847, the value eshift is corrected by solving the following equation: 
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10 



20 



25 



30 



flshifl —©Shift +0. 2 5 [deg]XK 

1 (0. 5^av0m< 1 .0[deg]) 

' I NT [ Cavem-0, 5) /O. 2 5] C3v5m>l . 0[deg]) 



where the upper limit of the value Oshift is set to 2.5 deg. In addition. "INT" means an operator denoting the integer 
part of the numerical value in the subsequent parentheses. After the corrected value 6shift is obtained in S47. the 
program advances to S60. 

(3) When the value am is smaller than 0.85 deg and the average value av em is equal to or smaller than -0.5 deg. 
75 i.e., when NO answers are obtained in S44 and S45, the program advances to S48. In S48. the value eshift is cor- 
rected by solving the following equation: 



©shift —©shift "0. 25 [deg]XK 

1 (-1 .0<3v9m^-0. SCdeg]) 

NT [ (-av8m-0. 5) /O. 2 5] (av 0 m^- 1 . 0 [dag]) 

where the lower limit of the value eshift is set to -2.5 deg. 



On the other hand, when a NO answer is obtained in any one of steps S41 to S43, it is determined that the optical 
axis 95 cannot be corrected by the correction value eshift calculated from the angle em. In this case, the program 
advances to S51 . 

Steps S51 to S53 determine whether or not all the following conditions (a) to (c) are satisfied, i.e., these steps 
determine whether or not the optical axis 95 can be corrected by the correction value Oshift calculated from the values 

35 es. 



(a) I es| ^ 100 deg (S51) 

(b) Ns^ 100 (S52) 

(c) One of the following conditions is satisfied. (S53) 

40 

A fail flag is in off-state. 

I etot I < 2.5 deg 
The representative value etot is not obtainable. 

In the case where ait the conditions (a) to (c) are satisfied, i.e., in the case where YES answers are obtained in all 
45 the steps S51 , S52 and S53, the program advances to S54. Otherwise, the current execution cycle ends. 

The values os and | avOs | are compared with 1.15 deg and 0.5 deg, respectively, in S54, and the value ay9s is com- 
pared with 0 deg in S45. On the basis of the comparisons, the value eshift is corrected as follows. 

(1) When the value os is equal to or larger than 1 .15 deg or the absolute value of the average value av Os (i.e., | 
50 aves I) is smaller than 0.5 deg, i.e.. when an YES answer is obtained in S54, the program advances to 860 with 

maintaining the current value eshift. 

(2) When the value as is smaller than 1.15 deg and the average value avem is equal to or larger than 0.5 deg. i.e., 
when a NO answer is obtained in 854 and an YES answer is obtained in S55, the program advances to S57. In 
S57, the value Oshift is corrected by solving the following equation: 

55 
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10 



so 



25 



©shift — ©shift +0. 2 5 [d e g] XK 

1 (0. 5^av0 s < 1 .OCdeg]) 

NT [ (av0s-O.5) /0.25] (av 0 s ^ 1 . 0 [dee]) 

where the upper limit of the value Oshift is set to 2.5 deg. After the corrected value Oshift is obtained in S57, the 
program advances to S60. 

(3) When the value as is smaller than 1.15 deg and the average value aves is equal to or smaller than -0.5 deg. i.e., 
when NO answers are obtained in S54 and S55. the program advances to S58. In S58, the value 0shrft is corrected 
by solving the following equation: 

5 Shi fl —9 Shift -0, 2 5 [d e g] XK 

( 1 (-1 .0<av& 5[deg]) 

NT [ (-avfi 5) /O. 2 5] (av 5 s ^- 1 . 0 [deg]) 



K= < 



where the lower limit of the value Oshift is set to -2.5 deg 

In the optical axis correction process, the sequence of steps S10. S20. S25. S31-S35, S41-S43. and S51-S53 are 
repeated in normal execution cycles. Once the optical axis correction is required, i.e.. when an YES answer is obtained 

30 in any one of steps S31-S33, S41 -S43, and S51-S53. the optical axis correction process is executed in S47, S48. S57 
or S58 as required. After the optical axis correction process, the program advances to S60. In S60. the fail flag is set to 
be on-state or off-state in the following manner Here, the fail flag, which is initially set to be off-state, indicates that the 
deviation of the optical axis 95 is too large to detect the forward object. If the fail flag turns to be on-state, the control 
unit 3 actuates the sensor abnormality indicator 1 7 to perform warning indication through a known routine, not shown. 

35 In S60, when the value | Oshift | is equal to or larger than 2.25 deg or the value | etot | is equal to or larger than 4.0 
deg, the fail flag is set to be on-state in S60. On the other hand, when the value | Oshift | is equal to or smaller than 1 .5 
deg or the value | Otot | is equal to or smaller than 1.5 deg, the fail flag is set to be off-state in S60. Othenwise, the fail 
flag remains in its current state. 

S70 following S60 supplies the values Oshift. Otot and the set value of the fail flag to the nonvolatile memory 67 for 

40 updating these data. After S70. the program advances to S 80. In S80. all the six statistical data Nm, ZOm. ZOm^, Ns. 
ses, and zes^ are cleared, and the program ends. It should be noted that when the value Ntot calculated during the cur- 
rent execution cycle is smaller than 100, S70 does not write the calculated value Ntot into the nonvolatile memory 67, 
and the previous value Ntot currently stored remains in the nonvolatile memory 67. In addition, the nonvolatile memory 
69 assigns a one-byte storage area to the value Oshift, a one-byte storage area to the value Otot, and a one-bit storage 

45 area to the fail flag, respectively. Further, the data representing the value eshift sequentially shifts its address every 
given interval, for example. 30 minutes so that previously-stored Oshift data will remain in the nonvolatile memory 67. 

After the correction value of the optical axis 95 represented by the value Oshift is calculated, the optical axis correc- 
tion block 61 outputs a signal corresponding to the value Oshift to the distance/angle measuring device 5 and the coor- 
dinate transformation block 41, so that the data input to the object recognition block 45 are corrected. In other words, 

so the optical axis correction block 61 decomposes or resolves the value Gshift calculated during the current execution 
cycle into a value oshi corresponding to an integral multiple of 0.5 deg and a value 0sh2 con*esponding to a remainder 
from the value Oshi. and supplies the distance/angle measuring device 5 and the coordinate transformation block 41 
with the values oshi and Osh2, respectively. These resolved values Oshi and 0sh2 exhibit the following relation: 

55 Oshift = Osh1 + 0sh2 ( Oshi = 0.5 [deg] x n). 

where "n" is an integer denoting the maximum absolute value of the values that satisfy the relation | Oshift | ^ 0.5 deg x 
I n I, and 
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esh2 = eshift - eshl. 

In the distance/angle measuring device 5, the transmitting/receiving section 31 scans an angular range of ± 0.8 deg 
from the optical axis 95 to both sides of the width direction of the subject vehicle 91 with a resolution of 0.5 deg for 

5 detecting the object 93 or 97. while the distance/angle calculating section 33 stores 33 data pieces, each representing 
a distance to the object 93 or 97 detected by each pulse of the laser light beam, at each address {D[1] to D[33]) in an 
internal memory. For this reason, the data pieces stored at the respective addresses D[1] to D[33] can be shifted 
sequentially by n data pieces to correct the deviation of the optical axis 95. For example, when "n" is set equal to 1 , the 
data pieces are shifted as shown in Fig. 9. The distance/angle calculating section 33 of the distance/angle measuring 

10 device 5 thus corrects the deviation of the optical axis 95 on the basis of the value eshl . In the example of Fig. 9. the 
address D[1] to which an undetected data is shifted is supplied with a data piece indicating that no reflected light beam 
has been detected. 

Even after correcting the optical axis 95 on the basis of the value esh1, the optical axis 95 has yet deviated from 
the centerline of the subject vehicle 91 by an angle smaller than 0.5 deg. It is therefore necessary to further correct the 
15 optical axis 95 by an angle ash2. The coordinate transformation block 41 thus corrects the deviation of esh2 during the 
coordinate transformation processing. For example, when the coordinate transformation block 41 executes the coordi- 
nate transformation processing according to the following relation: 

Y = r , and X = r • 0 . where 0 [rad] = 0 and "r" denotes a distance to the object, 
the optical axis 95 is corrected by solving the following equation. 

20 

X = r • ( e - esh2 • jc/180) 

Such corrections of the optical axis 95 allow the object recognition block 45 to accurately decide data pieces such 
as coordinate (X, Y) of the position of the center of the object, and hence the warning judgment and cruise judgment 

25 block 55 to accurately execute the warning determination and the cruise determination. On the other hand, in the case 
where the value Oshift is too large to detect the object, the fail flag is set to be on-state, so that the control unit 3 actuates 
the sensor abnormality indicator 17 to perform warning indication. In this case, the mounting angle of the transmit- 
ting/receiving section 31 of the distance/angle measuring device 5 needs to be corrected by a car mechanic (at an auto 
repair shop) on the basis of the value 0tot stored in the nonvolatile memory 67. 

30 As previously described, the optical axis correction block 61 executes two optical axis correction processings con- 
currently, one uses the value em calculated with respect to a moving object such as the preceding vehicle 93 and the 
other uses the value es calculated with respect to a stationary object such as the road-side object 97. Therefore, the 
value eshift is calculated on the basis of the value Os when there is no moving object such as preceding vehicle 93 in 
the forward direction of the subject vehicle 91 . while it is calculated on the basis of the value Om when a plurality of vehi- 

35 cles travels ahead of the subject vehicle and no stationary object such as road-side object 97 can be detected because 
such a stationary object is hidden by the vehicles ahead of the subject vehicle 91 . Since the value eshift can be calcu- 
lated irrespective of the road conditions, the deviation of the optical axis 95 can be automatically corrected in most 
cases. 

The calculations of the values em and es are made with respect to the respective objects which have been contin- 

40 uously detected during a given time interval or more, for example, five seconds for the value em and one second for the 
value es. Therefore, the value eshift can be calculated by eliminating the other data representing objects temporarily 
detected such as an erroneously-recognized object or a vehicle traveling along a lane adjacent to the subject vehicle's 
lane, and this makes it possible to accurately correct the deviation of the optical axis 95. Particularly the value em is 
calculated from the data representing the preceding vehicle 93 that has been continuously detected for a longer time, 

45 so that the correction of the optical axis 95 is improved more than the case the value Os is used for the correction. 

Further, the calculation of the value em is made with respect to a moving object having a speed (Vxr Vy) relative to 
the subject vehicle the absolute value of which is small enough, so that data representing a moving object such as a 
vehicle traveling along the adjacent lane or a vehicle detected during cornering can be eliminated. Furthermore, the cal- 
culation of the value em is made with respect to only a moving object the width W of which exhibits the relation that 1 .2 

50 m < W < 2.8 m, so that data representing a moving object such as a two-wheeled vehicle or a vehicle the one-side 
reflector of which cannot be detected, or data representing vehicles that are recognized as an object thought they are 
traveling side by side with each other. In most cases, these data are unsuitable for correcting the optical axis 95 
because of a high probability that the center coordinates (X, Y) thereof do not correspond to the canter line of the sub- 
ject vehicle's lane. Therefore, the deviation of the optical axis 95 can be corrected more accurately 

55 Fig. 1 0A shows center coordinates (X, Y) of objects each of which has been recognized as a moving object for five 
seconds or more on the assumption that the optical axis 95 is correctly oriented straight ahead of the subject vehicle 
91. On the other hand, Fig. 10B shows center coordinates (X, Y) of objects that are selected from among the objects 
exemplified by Fig. 10A. The objects the center coordinates (X, Y) of which are shown in Fig. 10B further satisfy the 
conditions related to the relative speed ( Vx, Vy) and the width W. As apparent from Figs. 1 0A and 1 0B, a target vehicle 



16 

BNSDOCID: <EP 0762008A2_I > 



EP 0 782 008 A2 



(e.g., the preceding vehicle 93) traveling straight ahead of the subject vehicle 91 can be properly extracted from the data 
representing moving objects by adding such limited conditions to the selection of the target object. Thus, the deviation 
of the optical axis 95 can be corrected with a very high accuracy. In addition, Figs. 10A and 10B assume each angle e 
at the right side of the subject vehicle 91 to be positive. 

£ In correcting the deviation of the optical axis 95 on the basis of the value 6s, since the value 9s is calculated with 

respect to a stationary object that satisfies the condition that Y § 40m, a calculation error resulting from the road con- 
dition such as a curve can be effectively avoided, so that the accuracy in correction can be further improved. Further, 
the values em and Os are calculated plural times to derive respective average values av em and av Os. The reliability of 
the average values em and Os is evaluated from the standard deviation am and as to compare the evaluated values av 

10 em and aves with each other. As a result, the value Oshift is corrected from one of the average values em and es the 
relatively of which is higher than the other. However, If both the average values em and es are not reliable, i.e., when 
the value etot is not obtainable, both the average values em and es are disabled for correcting the deviation of the opti- 
cal axis 95. Accordingly further accurate correction of the optical axis 95 can be carried out. 

In the case where the deviation of the optical axis 95 is too large to detect the target object, the value etot is calcu- 

15 lated by using only the values es. As previously described, although such a large deviation of the optical axis 95 makes 
it difficult to detect the preceding vehicle 93, the data representing the road-side object 97 can be used to calculate the 
value etot with a relatively high accuracy, so that the correction of the optical axis 95 is made possible even when the 
deviation of the optical axis 95 is relatively large. 

In the above embodiment, the value eshift is further decomposed or resolved into esh1 and esh2 to correct the opti- 

20 cal axis 95. In the example of Fig. 9, the deviation of the optical axis 95 is actually corrected as follows. The data stored 
at the addresses D[1] to D[33] are shifted sequentially in response to the value eshi , while the coordinate transforma- 
tion block 41 alters the equation for the coordinate transformation in response to the value esh2. The former processing 
is very easy to perform while the latter processing enables a highly accurate correction. Therefore, the accuracy of the 
warning determination or the cruise control can be also improved excellently 

25 Referring next to Figs. 1 1 to 1 4. a description will be made to an inler-vehicle distance control process which is exe- 

cuted on the basis of the amount of deviation of the optical axis 95 calculated as discussed above. The inter-vehicle 
distance control process is used as one solution for the cruise control, so that the subject vehicle 91 can travel with 
maintaining a given distance to a preceding vehicle 93. Fig. 1 1 shows a main flow of the inter-vehicle distance control 
process. 

30 The warning judgment and cruise judgment block 55 periodically executes the inter-vehicle distance control proc- 
ess. The inter-vehicle distance control process has a first step S91. The first step S91 executes a controllability judg- 
ment routine for determining whether or not the control is possible. The controllability judgment routine is shown in detail 
in Fig. 12. 

In Fig. 12, S91 1 to S921 determine whether or not conditions for executing inter-vehicle control are satisfied. Spe- 
35 cifically, S91 1 determines whether a control switch is set to be on-state for executing the control or to be off-state-for 
inhibiting the control. S91 5 determines whether or no a failure (abnormality) of the actuator such as the brake driver 19 
or the throttle driver 21 is detected. S91 7 determines whether the larger one between the values em and es calculated 
during the latest execution cycle of S10 (and after correcting the optical axis by an angle of the value eshift) is smaller 
than 1 deg or not S921 determines whether or not the shifted rate of the value eshift in the latest 30-minute interval is 
40 smaller than 1 deg or not 

In the case where all the above conditions are satisfied, i.e.. in the case where YES answers are obtained in all the 
steps S91 1 , S91 5, S91 7 and S921 , the program advances to S923. S923 turns on a controllability flag. After S923, the 
program returns to the main flow of Fig. 11. On the other hand, in the case where any one of the above conditions is 
not satisfied, i.e., in the case where a NO answer is obtained in any one of the steps S91 1 , S915, S917 and S921 , the 
45 program jumps to S925. S925 turns off the controllability flag. After S925, the program returns to the main flow of Fig. 
11. 

Returning to Fig. 1 1 , the program advances from S91 to S93. S93 determine whether or not the controllability flag 
is in the on-state or off-state. If the controllability flag is in the on-state, the program advances to S95. S95 executes an 
inter-vehicle control routine as described later. After S95, the inter-vehicle control process ends. On the other hand, if 
50 the controllability flag is in the off-state, the program advances to S97. S97 disables or stops the inter-vehicle control 
process and this program portion ends. 

Fig. 13 is a flowchart showing the details of the inter-vehicle control routine. The inter-vehicle control routine has a 
first step S951 . S951 reads data representing a distance to and an angle of each of obstacles which are detected 
through the distance/angle measuring device 5 and corrected by an angle of the value 6 shift. S953 following S951 exe- 
55 cutes a preceding obstacle recognition processing on the basis of the received data representing the distance to and 
angle of each of the detected obstacles. Specifically. S953 calculates the position and the speed of each of the detected 
obstacles relative to the subject vehicle. These calculations are made on the basis of the data derived from the object 
recognition block 45 and the relative speed calculation block 51 . 

S955 following S953 detects a curvature radius of a road along which the subject vehicle travels. Specifically, S955 
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reads the curvature radius R calculated or provided by the curvature radius calculation block 63. S957 following S955 
determines, on the basis of the curvature radius R. a same lane probability that the detected obstacle is present on the 
same lane as the subject vehicle. Since S951 and S953 have determined the two-dimensional position of each of the 
detected obstacles, the same lane probability is calculated for each detected obstacle. After S957, S959 selects a pre- 

5 ceding vehicle from among the detected obstacles on the basis of the results of the same lane probability calculation 
so that a distance to the selected preceding vehicle can be controlled. 

After S959, S961 calculates a target distance to the preceding vehicle in response to an input from a driver of the 
subject vehicle, while S963 calculates a target acceleration/deceleration value. As shown in detail in Fig. 14. the target 
acceleration/deceleration calculation routine is executed on the basis of the distance data related to the selected pre- 

10 ceding vehicle as follows. 

In Fig. 14, S9631 determines whether a preceding vehicle is present or absent. If the preceding vehicle is present, 
the program advances to S9633. Othenwise, the program advances to S9635. 

S9633 calculates a basic acceleration/deceleration value when the preceding vehicle is present on the basis of 
both the deviation of the target inter-vehicle distance from the distance data related to the preceding vehicle and the 

15 speed of the preceding vehicle relative to the subject vehicle previously calculated. On the other hand, S9635 calcu- 
lates a basic acceleration/deceleration value when the preceding vehicle is absent on the basis of required data such 
as data representing a distance to an angle of a target stationary object and the speed of the subject vehicle. After cal- 
culating the basic acceleration/deceleration value in S9633 or S9635. the program advances to S9637. S9637 deter- 
mines the maximum value (Om, es). As a result, if the maximum value (Om. Os) is smaller than 0.2 deg. the program 

20 advances to S9641 in which the correction value is set equal to 1. If the maximum value (Om, Os) is between 0.2 and 
0.5 deg, the program advances to S9643 in which the correction value is set equal to 0.5. If the maximum value (em. 
Os) is between 0.5 and 1 .0 deg, the correction value is set equal to 0.25. 

After setting the correction value in 39641, S9643 or S9645, the program advances to S9647. S9647 determines 
a target acceleration/deceleration value by multiplying the basic acceleration/deceleration value, provided by S9633 or 

25 S9635, and the correction value provided by S9641, S9643 or S9645. After the target acceleration/deceleration value 
is determined, the program returns to the inter-vehicle control routine of Rg. 13. 

In Fig. 1 3. the program advances from S963 to S965. S965 calculates a current target speed of the subject vehicle 
on the basis of the current acceleration/deceleration value and the immediately-previous target speed calculated during 
the latest execution cycle of the program. S967 following S965 outputs a drive signal to an actuator such as the brake 

30 driver 1 9 or the throttle driver 21 so as to control the speed of the subject vehicle. The speed control is performed such 
that the actual speed of the subject vehicle is made approximate to the target speed. After that, the inter-vehicle control 
routine ends. The subject vehicle is thus controlled to travel with a constant distance to the preceding vehicle being 
maintained. 

As previously described, the inter-vehicle distance control routine serves to control a distance between the subject 

35 vehicle and the preceding vehicle in accordance with the distance/angle data related to the preceding vehicle which has 
been corrected by an angle of the value Oshift, so that the control safety can be ensured. In the inter-vehicle distance 
control routine, the larger the maximum value (Om, Os), the smaller the correction value by which the basic accelera- 
tion/deceleration value is multiplied for reducing the acceleration/deceleration value. In the case where the optical axis 
of the transmitting/receiving section 31 is deflected, the larger the deflection, the smaller the acceleration/deceleration 

40 value will be. Therefore, the subject vehicle is prevented from being accelerated or decelerated excessively due to the 
deflection of optical axis, so that the subject vehicle can travel stably, thereby further Improving the control safety. 

In the case where the deflection of optical axis is too large to detect an obstacle or obstacles, or in the case where 
the deflection of optical axis changes suddenly (S917, S921), the inter-vehicle distance control is disabled. The former 
case has possibility of inaccurate the distance/angle data, while the latter case has possibility that something runs 

45 against the transmitting/receiving section 31 or near elements to cause deformation. In theses cases, it is undesirable 
to continue the inter-vehicle distance control processing. To this end, the inter-vehicle distance control routine stops 
control of the inter-vehicle distance, so that the control safety can be still more improved. 

In the above embodiment, the object recognition block 45 corresponds to the object recognizing means and the 
width calculating means, the steering angle sensor 27 and the curvature radius calculation block 63 correspond to 

50 Straight advancement determining means, the relative speed calculation block 51 corresponds to the speed calculating 
means, the transmitting/receiving section 31 corresponds to the transmitting means and receiving means, the dis- 
tance/angle calculating section 33 corresponds to the distance calculating means, and the addresses D[1] to D[33] of 
the distance/angle calculating section 33 correspond to the storage means, respectively. 

The optical axis correction block 61 includes Si 07 corresponding to the first deflection calculating means and 81 13 

55 corresponding to the second deflection calculating means and the third deflection calculating means. The optical axis 
correction block 61 also includes S20 which has the step of calculating the average values avOm and av Os correspond- 
ing to the average value calculating means and the step of calculating the values crm and as corresponding to the stand- 
ard deviation calculating means. Steps S25, S33, S35, S42. S44. S52 and S54 following S20 corresponds to the 
deflection evaluating means. Further, the step of shifting the distance/angle data executed by the distance/angle data 
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calculating section 33 and the step of altering the equation executed by the coordinate transformation block 41 corre- 
spond to the angle correcting means. In the warning judgment and cruise judgment block 55, S959 corresponds to the 
preceding vehicle selecting means. S961 to S967 correspond to the inter-vehicle distance control means, S97 and 
S9637 to S9647 correspond to control condition changing means, and S921 corresponds to the sudden-change detect- 

5 ing means, respectively. 

Although the present invention was specified by the above embodiment, It is not limited thereby and other embod- 
iments or modification can be embodied without departing from the scope of the invention as set forth in the appended 
claims. For example, although both the values Om and Os are used in the embodiment for correcting the optical axis, 
either of the values may be used therefor. Further in the embodiment, although the contents of the data measured by 

10 the distance/angle measuring device 5 and supplied to the coordinate transformation block 41 are corrected on the 
basis of the value eshift, the data in the transmitting/receiving section 31 may be altered or shifted in the same manner 
as that disclosed in Japanese published patent application No. 5-157843. Otherwise, the value eshift may be only 
stored as data for manually adjusting the position of the transmitting/receiving section 31 of the distance/angle meas- 
uring device 5 during maintenance of the vehicle. Furthermore, in the inter-vehicle distance control process, although 

15 the acceleration/deceleration value is reduced in response to the deflection value, the deflection of optical axis may be 
corrected by directing the acceleration/deceleration value to the decelerated side, or by increasing a target inter-vehicle 
distance. 

It should be understood that theforegoing.relates to only preferred embodiments of the present invention, and that 
it is intended to cover all changes and modifications of the embodiments of the invention herein used for the purpose of 
20 the disclosure, which do not constitute departures from the spirit and scope of the invention. 

Claims 

1 . An apparatus for calculating a deflection of central axis of an obstacle detecting apparatus mounted on a vehicle 
25 and operative to radiate a transmission wave over a given angular range from a given central axis to the width direc- 
tion of the vehicle and to detect a distance to and an angle of an obstacle in response to a reflected wave from the 
obstacle, comprising: 

object recognizing means for determining whether the obstacle is a stationary object or a moving object on the 
30 basis of changes in distance to and angle of the obstacle detected by the obstacle detecting apparatus; 

speed calculating means for calculating a vector representing a speed of the obstacle relative to the vehicle; 
and 

first deflection calculating means, when a target obstacle is selected from among obstacles detected by the 
obstacle detecting apparatus under conditions that the target obstacle has been recognized as a moving object 
35 by said object recognizing means and the relative speed thereof calculated by said speed calculating means 

falls within a given range, which calculates the deflection of central axis of the obstacle detecting apparatus rel- 
ative to the vehicle on the basis of an angle of the target obstacle. 

2. An apparatus for calculating a deflection of central axis of an obstacle detecting apparatus mounted on a vehicle 
40 and operative to radiate a transmission wave over a given angular range from a given central axis to the width direc- 
tion of the vehicle and to detect a distance to and an angle of an obstacle in response to a reflected wave from the 
obstacle, comprising: 

object recognizing means for determining whether the obstacle is a stationary object or a moving object on the 
45 basis of changes in distance to and angle of the obstacle detected by the obstacle detecting apparatus; 

speed calculating means for calculating a vector representing a speed of the obstacle relative to the vehicle; 
and 

second deflection calculating mean, when a target obstacle is selected from among obstacles detected by the 
obstacle detecting apparatus under conditions that the target obstacle has been recognized as a stationary 
50 object by said object recognizing means and the distance thereto detected by the obstacle detecting apparatus 

is less than a given value, which calculates the deflection of central axis of the obstacle detecting apparatus 
relative to the vehicle on the basis of the direction of the vector representing the relative speed of the target 
obstacle calculated by said speed calculating means. 

55 3, An apparatus as set forth in claim 1 . further comprising third deflection calculating means, when a target obstacle 
is selected from among obstacles detected by the obstacle detecting apparatus under a condition that the target 
obstacle has been recognized as a stationary object by said object recognizing means, which calculates the deflec- 
tion of central axis of the obstacle detecting apparatus relative to the vehicle on the basis of the direction of the vec- 
tor representing the relative speed of the target obstacle calculated by said speed calculating means. 
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4. An apparatus as set forth in claim 1 or 3, wherein when a target obstacle is selected, from among obstacles con- 
tinuously detected for a given time period or more by the obstacle detecting apparatus, under conditions the target 
obstacle has been recognized as a moving object by said object recognizing means and the components of the 
vector representing the relative speed thereof calculated by said speed calculating means falls within a given 

5 range, said first deflection calculating means calculates the deflection of central axis of the obstacle detecting 

apparatus relative to the vehicle on the basis of the angle of the target obstacle detecting by the obstacle detecting 
apparatus. 

5. An apparatus as set forth in any one of claims 1 , 3 and 4. further comprising width calculating means for calculating 
70 a width of an obstacle on the basis of the distance to and angle of the obstacle detected by the obstacle detecting 

apparatus, wherein when a target obstacle is selected from among obstacles detected by the obstacle detecting 
apparatus under conditions that the target obstacle has been recognized as a moving object by said object recog- 
nizing means, the components of the vector representing the relative speed thereof calculated by said speed cal- 
culating means falls within a given range, and the width thereof calculated by said width calculating means falls 
15 within a given range, said first deflection calculating means calculates the deflection of central axis of the obstacle 
detecting apparatus relative to the vehicle on the basis of the angle of the target obstacle detected by the obstacle 
detecting apparatus. 

6. An apparatus as set forth in any one of claims 1 and 3 to 5, further comprising: 

20 

average value calculating means for calculating a mean or average value of a plurality of deflect ions of central 
axis each of which is individually calculated as a result of plural calculation cycles of said first deflection calcu- 
lating means; 

standard deviation calculating means for calculating a standard deviation of the plurality of deflections; and 
25 a deflection evaluating means for evaluating the average value of the plurality of deflections to be a reliable 

value for the deflection of central axis of the obstacle detecting apparatus relative to the vehicle when the 
standard deviation is smaller than a given value and the number of deflections upon which the average value 
and the standard deviation are calculated is a given number or more, or for evaluating the value of each deflec- 
tion and the average value of the plurality of deflections to be unreliable values when the standard deviation is 
30 the given value or larger and the number of deflections is less than the given number 

7. An apparatus for calculating a deflection of central axis of an obstacle detecting apparatus for a vehicle, which 
includes either said second deflection calculating means or said third deflection calculating means as set forth in 
any one of claims 2 through 6. further comprising: 

35 

average value calculating means for calculating a mean or average value of a plurality of deflections of central 
axis each of which is individually calculated as a result of plural calculation cycles of said second or third 
deflection calculating means; 

standard deviation calculating means for calculating a standard deviation of the plurality of deflections; and 
40 deflection evaluating means for evaluating the average value of the plurality of deflections to be a reliable value 

for the deflection of cerrtral axis of the obstacle detecting apparatus relative to the vehicle when the standard 
deviation is smaller than a given value and the number of deflections upon which the average value and the 
standard deviation are calculated is a given number or more, or for evaluating the value of each deflection and 
the average value of the plurality of deflections to be unreliable values when the standard deviation is the given 
45 value or larger and the number of deflections is less than the given number. 

8. An apparatus for calculating a deflection of central axis of an obstacle detecting apparatus for a vehicle, which 
includes both said first deflection calculating means and said third deflection calculating means as set forth in any 
one of claims 3 through 7, wherein when an absolute value of the deflection calculated by said third deflection cal- 

50 culating means is a given value or larger, the value of the deflection calculated by said first deflection calculating 
means is neglected. 

9. An apparatus as set forth in any one of claims 1 through 8, further comprising straight advancement determining 
means for determining whether or not the vehicle is traveling straight, wherein said first, second or third deflection 

55 calculating means calculates the deflection only when said straight advancement determining means determines 
that the vehicle is traveling straight. 

10. An apparatus for correcting a deflection of central axis of an obstacle detecting apparatus for a vehicle, comprising 
angle correcting means for correcting the angle of the obstacle detected by the obstacle detecting apparatus on the 
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basis of the value of the deflection calculated by said deflection of central axis calculating apparatus as set forth in 
any one of claims 1 through 9. 

11 . An apparatus as set forth in claim 1 0, wherein the obstacle detecting apparatus comprising: 

5 

transmitting means for radiating a transmission wave every given angle in a scanning manner; 
receiving means for receiving a reflected wave from an obstacle; 

distance calculating means for calculating a distance to the obstacle on the basis of an interval of time between 
the moment of transmission of the transmission cave by said transmitting means and the moment of reception 

10 of the reflected wave by said receiving means; and 

storage means for storing data representing the distance to the obstacle provided by said distance calculating 
means with maintaining the one-to-one correspondence between the distance to the obstacle and the angle of 
radiation at which the corresponding transmission wave is radiated, such that said angle correcting means cor- 
rects the angle of the obstacle relative to the vehicle by changing the correspondence or the relation between 

15 the distance to the obstacle and the angle of radiation stored in said storage means. 

12. An apparatus as set forth in claim 10 or 11 . further comprising coordinate transforming means for transforming the 
distance to and angle of the obstacle detected by the obstacle detecting apparatus into a position of orthogonal 
coordinates by solving a given equation for coordinate transformation, such that the angle correcting means cor- 

20 rects the angle of the obstacle relative to the vehicle by changing or alternating the equation for coordinate trans- 

formation provided by said coordinate transformation means. 

13. An Inter-vehicle distance control system Including 

25 an obstacle detecting apparatus for a vehicle which serves to radiate a transmission wave over a given angular 

range along the central axis thereof for detecting a distance to and an angle of an obstacle, 
preceding vehicle selecting means for selecting a preceding vehicle from among obstacles detected by said 
obstacle detecting apparatus, the preceding vehicle corresponding to a target obstacle for which inter-vehicle 
distance control should be executed, and 

30 inter-vehicle distance control means for controlling the speed of the subject vehicle equipped with the system 

to hold a distance between the subject vehicle and the preceding vehicle selected by said preceding vehicle 
selecting means, said inter-vehicle distance control system comprising: 

an apparatus for calculating a deflection of central axis as set forth in any one of claims 1 through 9, which 
35 calculates a deflection of central axis of said obstacle detecting apparatus; and 

control condition changing means for changing the control condition of said inter-vehicle distance control 
means on the basis of the value of the deflection calculated by said deflection of central axis calculating 
apparatus. 

40 14. An inter-vehicle distance control system as set forth in claim 13, wherein said control condition changing means 
changes the value of acceleration/deceleration of the subject vehicle to be adjusted by said Inter-vehicle distance 
control means in response to the deflection calculated by said deflection of central axis calculating apparatus. 

An inter-vehicle distance control system as set forth in claim 14, wherein said control condition changing means 
reduces the value of the acceleration/deceleration of the subject vehicle to be adjusted by said Inter-vehicle dis- 
tance control means in response to the deflection calculated by said deflection of central axis calculating appara- 
tus. 

16. An inter-vehicle distance control system as set forth in claim 13, wherein said control condition changing means 
50 Stops the control processing to be executed by said inter- vehicle distance control means in response to the value 

of the deflection calculated by said deflection of central axis calculating apparatus. 

17. An inter-vehicle distance control system as set forth In claim 16, further comprising sudden-change detecting 
means for detecting a sudden change In deflection of central axis of said obstacle detecting apparatus, such that 

55 said control condition changing means stops the control processing to be executed by said inter-vehicle distance 
control means when a sudden change In deflection of central axis of said obstacle detecting apparatus is detected 
by said sudden-change detecting means. 



BNSDOCID: <EP 0762006A2_I_: 



21 



EP 0 782 008 A2 




CO I 



— QC 
-J O 

-a: »— 
cc s 

O OC C-) 
CO o — 
Z Z i=i 
UJ CQ 2: 

cn — 



o 
or 



o 
o 



TOO 

iTOR 


CD 






cc 

ixJ UU 


UJ 




<c — 




^ — 


UJ a:^ 
o_ z 








DC QC 




CO CO 






oo — 











CO 



CO 
CO 



CO 



o 

— or 

O CO UJ 
— CO —I 

I -J 

<C S CD 

S cyo cc 
o z I— 
<c z 

=D QC O 
-«C i— C-> 



-J o 
I— — QC 
I— CD 
CD — CO 
CC CO z 
=n o LU 
I— o_ CO 



CD 
QC 



QC 











UJ 






-< z 


z 


-J o 




UJ 


K- -J C-> 1— 


COC5 — 1 C-> 




<r: UJ 


CD CO 



o 

QC 



C3 



CO 



CD 
CO 



C9 

z 



s — o 

CO UJ — 
Z CD f— 
-cC UJ CD 
QC QC UJ 
I— \CO 



22 

BNSDOCID: <EP O7e2O0eA2_l_> 



EP 0 782 008 A2 



FIG. 2 3 -.] CONTROL UNIT 



DISTANCE/ 
ANGLE 
MEASURING 
DEVICE 



dshi 



DISTANCE/ANGLE 
DATA 

oB 



SPEED 
INDICATOR 



11 



THROnLE 
POSITION 
SENSOR 



25 



ALARM 

SENSITIVITY 

SEHING 

DEVICE 



BRAKE 
SWITCH 



COORDINATE 
TRANSFORMATION 

— m 



43 



SENSOR 

ABNORMALITY 

DETECTION 



17 



SENSOR 
ABNORMAL in 
INDICATOR 



45 



OBJECT 
RECOGNITION 



CURVATURE 
RADIUS 



/49 



VEHICLE 
SPEED 

CALCULATION 



55 



WARNING 

JUDGMENT 

AND 

CRUISE 
JUDGMENT 




u2l 



63 



CURVATURE 

RADIUS 

CALCULATION 



61 



VEHICLE 
SPEED 



OPTICAL AXIS 
CORRECTION 



flshift etot 
FAIL FLAG 



NONVOLATILE 
MEMORY 



67 



TYPE OF OBJECT 



DISTANCE 
INDICATED 
OBJECT 
SELECTION 



47 



RELATIVE 
SPEED 

CALCULATION 



51 



FORWARD 
VEHICLE 
ACCELERATION 
CALCULATION 



53 



\ 



WIDTH OF 
OBJECT 



15 



DISTANCE 
INDICATOR 



COORDINATE (X,Y) 
OF CENTER POSITION 
OF OBJECT 

RELATIVE 
SPEED 

ACCELERATION 
OF PRECEDING 
VEHICLE 



13 



ALARM 
GENERATOR 



23 



AUTOMATIC 

TRANSMISSION 

CONTROLLER 



/19 



BRAKE 
DRIVER 



/2I 



THROTTLE 
DRIVER 



23 

BNSDOCID: <EP 0782008A2J_> 



EP 0 782 008 A2 




EP 0 782 008 A2 



FIG. 6 



( START ) 





^SIO 




DEVIATION OF OPTICAL AXIS 
CALCULATION ROUTINE 










STATI 


ST ICS 








CALCULATE VALUES etot 
AND Ntot 



,S31 

30 MINUTES 
HAS ELAPSED SINCE THE 
PREVIOUS EXECUTION 
CYCLE ? 



NO 

NmSeOO ? 
NO 

NsS 400 ? 
NO 

1 



,S33 



.S35 



YES 



_ YES 




_ YES 


^ 


^S60 


FAILURE JUDGMENT | 




^S70 


UPDATE BACKUP DATA | 




^S80 


CLEAR DATA FOR 
STATISTICS 






► 



■0 



( END ^ 



25 



EP 0 782 008 A2 



FIG. 6 




BNSDOCID: <EP 07e2008A2_l_> 



26 



EP 0 782 008 A2 



FIG. 7 




078200eA2_l. 



27 



EP 0 782 008 A2 



FIG. 8 




ein= (X/Y) • (180/jt) [deg] 




es= (Vx/Vy) ■ (180A) [deg] 



4 

( RETURN ~^ 



28 



EP 0 782 008 A2 



FIG. 9 



, V D[l]. D[2] . - . D[32] . D[33] 

( UNDETECTED 



D[l] . DI2] . - . D[32] . D[33] 




( eliminated) 



29 

BNSDOCID: <EP 0782008A2J_> 



EP 0 782 008 A2 





30 

BNSDOCID; <EP 0782008A2J_> 



EP 0 782 008 A2 



FIG. 11 



( START ~^ 



S91 



CONTROLLABILITY 
JUDGMENT ROUTINE 



S93 




OFF 



S95 



INTER-VEHICLE CONTROL 
ROUTINE 



S97 



STOP INTER-VEHICLE 
CONTROL 



c 



END 



BNSDOCID: <EP 07e2008A2_L> 



31 



EP 0 782 008 A2 



FIG. 12 

( CONTROLLABILITY "\ 
V JUDGMENT ROUTINE J 



5911 




NOT DETECTED 
S917 



OFF 



DETECTED 




1 DEC. OR 
LARGER 



SMALLER THAN 1 DEG. 



,5921 




1 DEG/30MIN 
OR LARGER 



SMALLER THAN 1 
DEG/30MIN 

5923 



TURN ON 
CONTROLLABILITY FLAG 



5925 



TURN OFF 

CONTROLLABILITY FLAG 



RETURN ~^ 



32 

BNSDOCID: <EP 0782008A2J_> 




EP 0 782 008 A2 



FIG. 13 



INTER-VEHICLE 
CONTROL ROUTINE 



3 



READ DISTANCE/ANGLE DATA 



S951 



RECOGNIZE PRECEDING OBSTACLE 



S953 



DETECT CURVE 



SAME LANE PROBABILITY 



8955 



39 57 



ELECT PRECEDING VEHICLE 



8959 



CALCULATE TARGET INTER- 
VEHICLE DISTANCE 



CALCULATE TARGET ACCEL/DECEL 
VALUE 



S961 



8963 



CALCULATE TARGET SPEED 



8965 



CONTROL SPEED 



8967 



( RETURN ) 



33 



EP 0 782 008 A2 



FIG. 14 



0.2 OEG. 
OR SMALLER 



S9641 



TARGET ACCELERATION/ 
DECELERAT I ON OA LCU LAT I ON 
ROUTINE 



) 




ABSENT 



CALCULATE BASIC ACCEL/ 
DECEL VALUE WHEN 
PRECEDING VEHICLE IS 
PRESENT 



S9635 



CALCULATE BASIC ACCEL/ 
DECEL VALUE WHEN 
PRECEDING VEHICLE IS 
ABSENT 



S9637 




0. 5~1 [deg] 



S9643 



0. 2—0. 5[degl 



CORRECTION 
VALUE=1. 0 

1 



CORRECTION 
VALUE =0. 5 



S9645 



CORRECTION 
VALUE =0. 25 

\ 



Xf^fI" - ACCEL/ ^ CORRECTION 
DECEL ^ VALUE 
VALUE 



DECEL = 
VALUE 



c 



S9647 



RETURN 



34 



BNSDOCID: <EP_0782008A2_I_> 



EP 0 782 008 A2 



FIG. 15A 



SPEED 

CALCULATING 
MEANS 



OBSTACLE 

DETECTING 

APPARATUS 



OBJECT 
RECOGN I 
MEANS 



ZING 





FIRST 

DEFLECTION 

CALCULATING 

MEANS 




► 


4 



FIG. 15B 



SPEED 

CALCULATING 
MEANS 



OBSTACLE 

DETECTING 

APPARATUS 



OBJECT 

RECOGNIZING 

MEANS 





SECOND 
DEFLECTION 
CALCULATING 
MEANS 


4 







35 



-1 

3 



(19) 



J 




(12) 



(88) Date of publication A3: 

09.12.1998 Bulletin 1998/50 

(43) Date of publication A2: 

02.07.1997 Bulletin 1997/27 

(21) Application number: 96120954.1 

(22) Date of filing: 27.12.1996 



Eur pdisches Patentamt 
European Patent Office 
Office europe ndes brevets (11) EP 0 782 008 A3 

EUROPEAN PATENT APPLICATION 

(51) int.Ci.«: G01S 17/93. G01S 7/497 



(84) 


Designated Contracting States: 


• Hibino, Katsuhiko 




DE FR GB 


c/o DENSO CORPORATION, 


(30) 




Kariya-city, Aichi-pref. 448 (JP) 


Priority: 27.12.1995 JP 341668/95 


• Nishimura, Takao 




21.10.1996 JP 278233/96 


c/o DENSO CORPORATION, 


(71) 




Kariya-city, Aichi-pref. 448 (JP) 


Applicant: DENSO CORPORATION 




Kariya-City Aichi-Pref. 448 (JP) 


(74) Representative: 


(72) 




Winter, Brandl, Fiirniss, Hiibner, Ross, 


Inventors: 


Kaiser, Polte, Kindermann 




Shiral, Noriaki 


Partnerschaft 




C/o DENSO CORPORATION, 


Patent- und Rechtsanwaltskanzlei 




Kariya-city, Alchi-pref. 448 (JP) 


Alois-Stelnecker-Strasse 22 
85354 Freising (DE) 



FIG. 3 



(54) Apparatus for calculating and correcting deflection of central axis of an obstacle detecting 
apparatus mounted on a vehicle, and system for controliing distance to a preceding vehicle 
travelling ahead 

(57) The present invention aims to facilitate easy 
correction of the center axis of an obstacle detecting 
apparatus for a vehicle by calculating deflection of the 
center axis with respect to the vehicle. Each of most 
obstacles recognized as moving objects is a preceding 
vehicle 93, and when the subject vehicle 91 is moving 
straight, the preceding vehicle 93 is detected in a posi- 
tion straight ahead of the subject vehicle 91 . If the opti- 
cal axis 95 of the transmitting/receiving section 31 Is 
oriented straight ahead of the subject vehicle 91, the 
preceding vehicle 93 will be detected on the optical axis 
95. On the other hand, when the optical axis 95 deviates 
from the center axis of the vehicle, the preceding vehicle 
93 is detected in a position deviated from the optical 
axis 95 by an angle em. In this case, the value e of 
deflection of optical axis 95 is equal to -Om. In addition, 
by determining whether or not the relative velocity vec- 
tor component of an obstacle is within a given range, the 
accuracy of calculation can be bettered with data of 
vehicles moving in an adjacent lane and data of vehicles 
moving along a curve being removed. 
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